#include "State_Passive.h"
#include "Dog.h"

#define KD_F 1.6f
#define KD_B 1.6f

void Passive_Enter(void)
{
    UART_Print("passive enter\n");

    HT_SetDamp(dog.legs[0].motorF, KD_F);
    HT_SetDamp(dog.legs[0].motorB, KD_F);
    HT_SetDamp(dog.legs[1].motorF, KD_F);
    HT_SetDamp(dog.legs[1].motorB, KD_F);
    HT_SetDamp(dog.legs[2].motorF, KD_B);
    HT_SetDamp(dog.legs[2].motorB, KD_B);
    HT_SetDamp(dog.legs[3].motorF, KD_B);
    HT_SetDamp(dog.legs[3].motorB, KD_B);
}
void Passive_Run(void)
{
    // UART_Print("passive run\n");
}
void Passive_Exit(void)
{
    UART_Print("passive exit\n");
}